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ABSTRACT 


A  computer  simulation  was  developed  in  order  to  provide 
a  method  of  establishing  the  potential  of  brushless  DC 
motors  for  applications  to  tactical  cruise  missile  control 
surface  positioning.  In  particular  an  altitude  hold 
controller  has  been  developed  that  provides  an  operational 
load  test  condition  for  the  evaluation  of  the 
electromechanical  actuator. 

A  proportional  integral  control  scheme  in  conjunction 
with  tachometer  feedback  provides  the  position  control  for 
the  missile  tailfin  surfaces.  The  fin  control  system  is 
further  imbedded  in  a  cruise  missile  model  to  allow  altitude 
control  of  the  missile. 

The  load  on  the  fin  is  developed  from  the  dynamic  fluid 
environment  that  the  missile  will  be  operating  in  and  is 
proportional  to  such  factors  as  fin  size  and  air  density. 

The  program  written  in  CSMP  language  is  suitable  for 
parametric  studies  including  motor  and  torque  load 
characteristics,  and  missile  and  control  system  parameters. 
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1.   INTRODUCTION 


Hydraulic  actuators  have  been  the  most  effective  means 
to  control  the  fins  of  cruise  missiles  for  many  years.  High 
torque  loads  are  often  felt  on  the  control  surfaces  and 
heretofore  servo  motor  control  has  not  often  been  attempted 
because  of  size  constraints  and  the  necessary  torques 
required  to  dynamically  control  the  missile  fins. 

The  advent  of  brushless  DC  motors  possessing  very  strong 
magnetic  fields  presents  an  opportunity  to  investigate 
missile  control  using  these  motors  rather  than  the  more 
conventional  hydraulic  actuators.  A  simplified  model  of  a 
brushless  DC  motor  is  used  as  a  basis  for  a  fin  positioning 
controller.  This  controller  is  then  utilized  in  a 
simplified  generic  missile  model  to  develop  an  altitude  hold 
controller.  The  characteristics  of  the  DC  motor  can  be 
adjusted  to  determine  the  ability  of  that  particular  motor 
to  dynamically  control  the  fins  of  the  missile  and 
ultimately  to  dynamically  control  a  missile  in  flight. 

Four  phases  of  development  are  necessary  to  develop  the 
computer  program  for  missile  flight  simulation.  The  first 
phase  entails  the  development  of  the  DC  motor  model  and  the 
necessary  assumptions.  The  second  phase  places  the  motor  in 
a  proportional   -   integral   (PI)   controlling   system  with 


tachometer  feedback  supplementing  the  natural  back 
electromotive  force  (BEMF)  exerted  by  the  motor  itself. 
Next  the  missile  model  is  developed.  The  final  phase  is  the 
development  of  an  altitude  hold  controller  which 
incorporates  the  missile  model  and  the  fin  positioning 
controller . 

To  verify  the  CSMP  simulation,  the  equations  of  motion 
were  also  programmed  in  the  FORTRAN  language.  These 
routines  were  used  to  compare  the  test  runs  described  in 
section  V.,  for  accuracy  of  the  model  simulation. 

The  computer  program  provides  to  the  user,  the  ability 
to  modify  the  motor  parameters,  missile  parameters,  and  to 
adjust  the  dynamic  characteristics  of  the  fin  controller  and 
altitude  hold  controller.  This  program  provides  an  effective 
tool  in  the  study  of  brushless  DC  motor  actuators  used  in 
dynamic  missile  systems. 


II .   DC  MOTOR  MODEL  DEVELOPMENT 

The  initial  brushless  DC  motor  model  developed  by  Steve 
Thomas  [Ref .  1]  .  has  been  used  as  a  starting  point  for  this 
work.  Program  number  2  of  [Ref.  1]  incorporated  a 
commutator  switching  scheme  to  allow  modeling  of  brushless 
operation,  see  Fig.  2.1.  The  need  to  create  a  model  which 
will  allow  the  study  of  motor  performance  under  dynamic  load 
conditions  as  well  as  static  load  conditions  seems  to  be  a 
natural  follow  on  to  the  work  performed  in  [Ref.  1] . 

It  is  well  known  that  the  electrical  time  constant  of  a 
DC  motor  is  small  compared  to  the  mechanical  time  constant 
of  the  motor.  This  allows  the  assumption  that  the  armature 
inductance  is  small  enough  to  neglect.  Using  this 
knowledge,  a  continuous  model  of  the  DC  motor  with  the  same 
physical  parameters  as  in  [Ref.  1]  has  been  selected,  see 
Fig.  2.2.  In  computer  simulation  of  navigation  type 
controllers,  only  the  slower  time  constants  are  of  interest. 
Whenever  fast  time  constants  are  also  included, 
computational  difficulties  are  encountered  because  of  the 
small  integration  time  interval  requirements. 
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Figure  2.1  Basic  Brushless  DC  Motor  Model 
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Figure  2.2  Modified  DC  Motor  Model 
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Ill  .   FIN  POSITION  CONTROLLER 

A.   TORQUE  GENERATION  MODEL 

One  of  the  first  steps  in  the  design  of  a  fin  position 
controller  is  to  design  a  dynamic  input  to  the  load  torque 
of  the  DC  motor  model.  This  is  accomplished  using  the 
dynamic  lift  force  relationship  established  in  [Ref.  3],  as 
follows: 

2 
Lift  Force   =  (CI  x  air  density  x  area  x  velocity  )  /  2 

where  CI  is  the  force  coefficient 

CI  =  velocity  x  characteristic  length  /  kinematic  viscosity 

The  force  coefficient  is  usually  determined 
experimentally  from  airfoil  tests.  The  lift  force  is 
defined  to  be  perpendicular  to  the  velocity  vector  of  the 
fin.  The  total  force  vector  is  the  sum  of  the  lift  force 
and  the  drag  force  vectors. 

Some  simplifying  assumptions  have  been  made.  The  total 
force  vector  is  assumed  to  be  approximately  equal  to  the 
lift  force  vector  for  small  fin  deflections  ie.  less  than  15 
degrees  deflection  above  or  below  the  velocity  vector.  The 
coefficient  of  drag  is  less  than  one  tenth  the  coefficient 
of  lift  for  these  angles,  see  Fig.  3.1. 
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In  the  computer  simulation,  CI  is  modeled  as  a  linear 
ramp  that  saturates  at  plus  or  minus  13  degrees  fin 
deflection,  and  is  approximately  equal  to  1/10  fin 
deflection  angle.  The  lift  force  is  converted  to  a  torque 
by  multiplying  by  the  moment-arm.  The  moment-arm  is  the 
distance  from  the  rotational  axis  of  the  fin  to  it's  center 
of  pressure.  Although  in  a  dynamic  system  the  center  of 
pressure  changes  slightly,  it  has  been  assumed  that  it  is 
constant.  Fig.  3.2  shows  the  torque  load  block  diagram. 
System  generated  Motor  torque  and  Load  torque  for  maximum 
size  step  inputs  is  shown  in  Fig.  3.3  and  Fig  3.4 
respectively. 

B.  TACHOMETER  FEEDBACK 

Inherent  back  emf  of  the  motor  provides  some  speed 
regulation,  but  is  not  sufficient  to  adequately  control  the 
motor  speed.  The  back  emf  constant  of  the  motor  is 
supplemented  by  an  additive  constant  that  would  be  provided 
by  a  tachometer.  This  rate  feedback  allows  the  desired 
speed  regulation  and  quick  response  to  commanded  inputs. 

C.  PROPORTIONAL  INTEGRAL  CONTROL 
1 .   General 

A  series  proportional-integral  control  scheme  is 
used  for  precise  position  control  of  the  fin.  The  position 
error  is  generated  by  closing  the  loop  with  a  constant  gain 
amplifier  as  shown  in  Fig.  3.5. 
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2 .   Transfer  Function  Analysis 

The  uncompensated  motor  transfer  function  is  easily 
obtained  for  various  system  parameters  using  Program  1 
written  in  Basic  language  in  appendix  C.  A  sample  output  is 
provided  in  appendix  B.  For  the  parameters  used  in  this 
simulation  the  uncompensated  motor  transfer  function  Gl(s) 
becomes : 


15.9 
Gl(s)  = 


S2(. 03014)  +  S(176.8125)  +  (125.5584) 


The  open  loop  transfer  function  is  linearized  by 
restricting  the  operational  range  so  as  to  not  include  the 
saturation  region  of  the  coefficient  of  lift  equation,  (this 
is  not  necessary  for  program  operation,  but  only  for  linear 
analysis.  The  forward  loop  transfer  function  G(s) 
Gc(s)Gl(s)   becomes: 


S(3180)  +  (1590) 
G(s)  = 


S3  (.03)  +  S2  (176.8)  +  S  (125.5 


where  Gc(s)  is  the  transfer  function  for  the  PI  controller. 
Using  the  coefficients  derived  from  this  forward  transfer 
function  and  including  the  feedback  constant  (Knvrt),  which 
has  been  set  to  35,  the  compensated  open  loop  and  closed 
loop  Bode   plots   can   be  seen   in  Fig.   3.6   and   Fig.   3.7 
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respectively.  System  response  is  quite  fast  with  a  response 
time  of  3  msec,  for  full  scale  fin  deflection  accurate  to 
within  .01  degrees  of  desired   fin  angle. 

For  substitution  of  the  Fin  controller  into  the 
missile  plant  the  overall  fin  controller  transfer  function 
can  also  be  evaluated  using  Program  1  in  appendix  C.  This 
transfer  function 

Geq  (s)  =  G  (s)/l  +  G(s)H (s) 

for  the  parameters  used  in  this  simulation  is  as  follows: 


S(3180)  +  (1590) 
Geq(s)  = 

SJ(.03)  +  Sz(176.8)  +  S(1113126)  +  (556500 


3 .   Bode  Analysis 

Bode  plot  analysis  was  used  to  design  the  fin 
position  controller.  The  motor  transfer  function  including 
velocity  feedback  and  torque  load  generator  is  reduced  to 
the  equivalent  transfer  function 


Kt 
Gl(s)  = 

SMD2)  +  S(D]_)  +  D0 
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where  all  transfer  function  coefficients  are  detailed  in 
Program  1  appendix  C.  and  can  be  obtained  for  specific 
parameters. 

This  is  a  type  zero  system  which  for  the  constants 
chosen  (see  appendix  C  for  chosen  parameters)  yields  poles 
at  -.71  and  -5865.  The  permanent  magnet  motor  itself  is  a 
type  1  system.  Derivation  of  the  torque  felt  from  the  fin 
allows  reduction  of  the  system  to  a  single  input  single 
output  system,  however  it  uses  a  feedback  loop  which  causes 
the  effective  transfer  function  of  the  motor  system  to 
become  a  type  0  system.  The  motor  system  also  includes 
velocity  feedback  which  was  derived  from  the  original  back 
emf  constant  of  the  system  plus  an  additional  amplifier  to 
boost  the  rate  feedback  stabilization  effect.  Without 
boosting  this  feedback  which  is  easily  derived  with  the  use 
of  a  tachometer  the  system  oscillates  and  does  not  damp  out 
well . 

The  obvious  thing  to  do  with  the  motor  system 
transfer  function  Gl(s)  is  to  increase  it  to  a  type  1  system 
to  allow  zero  steady  state  error  to  a  step  input.  A 
proportional-integral  (PI)  controller  is  chosen  with 
constants  Kp  and  Ki  such  that  Gc(s)  =  Kp  +  Ki/s.  This  PI 
controller  is  placed  in  cascade  with  the  motor  system 
transfer  function  to  yield  the  forward  system  transfer 
function  G(s)  as  follows: 
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G(s)  = 


_s(Ni)_t  "a 

S3(D2)  +  S2  (DL)  +  S(D0) 


The  effect  of  the  PI  controller  is  to  introduce  a 
pole  at  zero,  and  a  zero  at  -Ki/Kp.  Ki  has  been  chosen  to 
be  100  and  Kp  has  been  chosen  to  be  200.  These  values 
position  the  new  system  zero  at  minus  .5.  This  zero  is  to 
the  left  of  the  dominant  system  root  and  allows  very  quick 
servo  mechanism  response,  in  a  system  which  is  stable  for 
all  positive  values  of  system  gain.  A  damping  ratio 
approximately  equal  to  .44  is  achieved  with  the  PI 
controller.  From  the  Open  loop  Bode  plot  the  phase  margin 
is  44  degrees,  gain  margin  is  7  DB,  and  band  pass  frequency 
is  4000  rad/sec.  The  peak  frequency  magnitude  is  1.36  at 
5000  rad/sec  as  seen  on  the  closed  loop  Bode  plot  Fig.  3.7. 
From  [Ref.  4]  second  order  approximations  show  the  natural 
frequency  to  be  2920  rad/sec,  settling  time  is  .003  sec, 
overshoot  magnitude  is  1.24,  system  time  constant  is  .00086 
sec,  and  transient  oscillating  frequency  is  2676  rad/sec. 
Figure  3.8  shows  the  fin  controller  time  response  using  the 
parameters  described  above. 

The  Bandwidth  of  the  fin  controller  is  strongly 
influenced  by  the  feedback  constant  H(s).  This  feed  back 
gain  is  set  equal  to  35  x  N,  where  N  is  the  gear  reduction 
of  the  fin  mechanism   (N  =  10  in  this  simulation)  .    This 
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large  negative  feedback  constant  greatly  increases  the 
bandwidth  of  the  system,  but  is  able  to  achieve  quick  fin 
response  times  without  long  settling  times.  Trials  were 
conducted  to  attempt  to  reduce  the  system  bandwidth  by 
locating  the  PI  zero  further  in  the  left  half  plane.  It  is 
possible  to  reduce  the  system  bandwidth  in  this  manner, 
however  a  tradeoff  must  be  made  in  sacrificing  response 
time.  System  bandwidth  can  be  reduced  to  about  100 
rad./sec.  by  placing  the  compensator  zero  at  minus  50  by 
setting  Ki  =  100  and  Kp  =  2,  see  open  and  closed  loop  Bode 
plots  Figures  3.9  and  3.10.  Doing  this  allows  a  motor 
response  time  for  full  scale  fin  deflection  of  .05  sec., 
(see  Figure  3.11)  which  would  be  adequate  for  many  cruise 
missle  applications. 

Additional  controller  designs  such  as  the  use  of 
derivative  as  well  as  proportional  and  integral  control  and 
lead-lag  filter  sections  could  be  developed  to  provide  low 
bandwidth  and  fast  fin  response  times,  however  the 
optimization  of  the  controller  design  as  stated  in  Section 
II.  was  not  the  primary  objective  of  this  work. 
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Figure  3.1  Lift  Coefficient  Graph 
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Figure  3.2  Torque  Load  Block  Diagram 
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Figure  3.3  Motor  Torque  Response  to  Step  Input 
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Figure  3.4  Load  Torque  Response  for  Step  Input 
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Figure  3.5  Fin  Position  P-I  Controller 
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Figure  3.6  Open  Loop  Bode  Plot  Ki  =  100,  Kp  =  200 
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Figure  3.7  Closed  Loop  Bode  Plot  Ki  =  100,  Kp  =  200 
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Figure  3.8  Fin  Position  Time  Response 
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Figure  3.9  Open  Loop  Bode  Ki  =  100,  Kp  =  2 
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Figure  3.10  Closed  Loop  Bode  Ki  =  100,  Kp  =  2 
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Figure  3.11  Fin  Position  Time  Response 
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IV.    MISSILE  MODEL  DEVELOPMENT 

In  order  to  study  the  effects  of  missile  flight  upon  the 
motor,  the  missile  system  dynamics  must  first  be  adequately 
modeled.  The  missile  equations  are  developed  with  reference 
to  Fig.  4.1,  which  shows  diagramatically  the  missile  pitch 
plane  dynamics.  Control  of  the  missile  in  the  yaw  plane  can 
be  accomplished  in  a  similiar  manner.  The  pitch  plane  was 
chosen  so  that  the  effects  of  gravity  can  easily  be 
incorporated  in  the  study  of  the  motor  characteristics. 

A  description  of  the  missile  plant,  operating 
conditions,  and  specific  system  parameters  used  in  the 
simulation  are  needed  as  ground  work  for  a  thorough 
understanding  of  the  Pitch  plane  dynamic  equations  to  be 
developed.  Pitch  control  is  effected  by  means  of  a  rear 
mounted  movable  aerodynamic  fin  with  total  surface  area 
equally  distributed  on  each  side  of  the  missile  for  a  total 
of  two  square  feet.  It  is  assumed  that  both  fin  sections 
operate  together  using  one  DC  motor  for  control.  In  actual 
operation  four  fins  each  independently  controlled  by  one  DC 
motor  is  more  likely.  Missile  roll  stability  is  assumed  to 
be  provided  by  a  similiar  vertically  oriented  system,  but 
certainly  possessing  independently  controlled  fins. 
Vertical  missile  orientation  is  therefore  assured  for  this 
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model  and  is  assumed  to  be  constant.  The  missile  length  is 
ten  feet,  effective  surface  area  is  twelve  feet  and  the 
weight  of  the  missile  is  assumed  to  be  1000  pounds.  The 
missile  is  assumed  to  be  a  narrow  rigid  body  for  purposes  of 
computation  of  the  moment  of  inertia  in  the  transverse 
plane.  This  assumption  leads  to  the  following  moment  of 
inertia  (Iz)  equation  (see  appendix  A  for  equation  symbol 
definitions) : 


Iz  =  (1  /  12)  x  MASS  x  Lm2 


where  Lm  is  the  missile  length.  The  formulation  of  a  force 
balance  equation  with  respect  to  the  reference  missile 
direction  yields: 


d2Y 


— -  =  [ (K.  x  a)  -  (K-  x  Y)  -  Wn]  /  MASS 
dt"1 


where  a  is  the  missile  attack  angle,  Y  is  the  angle  between 
the  missile  axis  and  the  horizontal  reference  (pitch  angle), 
and  where  Wn  =  mg  cos  (  <J>  )  and  0=0  for  a  horizontally 
referenced  system,  i.e.  the  X  direction  is  along  the  earths 
surface.  A  moment  balance  about  the  missile  pitch  axis 
gives: 
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d2Y  d  Y 

---  =  I(K,  x  6 )  -  (K4  x  a  )  -  (Ks  x  — ) ]  /  Iz 

6tz  *  °         dt 


The  constants  Kl  through  K5  in  the  missile  equations  of 
motion  above  are  derived  from  the  aerodynamic 
characteristics  of  the  fin  and  the  missile  and  give: 

Kx  =  (Clm)  x  (Am)  x  (Qk) 

K2  =  (Cdm)  x  (Am)  x  (Qk) 

K3  =  (Clf)  x  (Af)  x  (Qk)  x  (L2) 

K4  =  (Clm)  x  (Am)  x  (Qk)  x  (1^) 

K5  =  [ (Cmq)  x  (Am)  x  (Lm) 2  x  (Qk)]  /  [2  x  (Vm) ] 

where  Cmq  (missile  moment  coefficient)  is  assumed  to  be  .5 
and  CI  (coefficient  of  lift  for  both  the  fin  and  the 
missile)  is  set  to  .1  while  the  drag  coefficient  Cdm  is 
set  to  .01  using  the  lift  coefficient  curves  from  wind 
tunnel  data  similiar  to  those  of  Fig.  3.1. 


Qk  =  (Pair  /  2)  x  (Vm) 2 


P 


"3 

air  has  been  assumed  to  be  constant  at  .002378  (slugs/ft  ) 


for  near  sea  level  operation  and  Vm,  the  missile  velocity  is 

2000  ft/sec.   The  missile  surface  area  and  fin  surface  area 

2  2 

(Vm  and  Vf)  have  been  set  to  12  ft   and  2  ft   respectively. 

The  missile  center  of  pressure  moment  arm  about  the  missile 
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center  of  gravity  (LI)  has  been  set  to  1  foot  and  the  fin 
moment  arm  about  the  missile  center  of  gravity  (L2)  has  been 
set  to  5  feet. 

The  pitch  angle  of  the  missile  (Y)  is  equal  to  the  sum 
of  the  missile  attack  angle  («)  and  (8),  where  6  is  the 
direction  of  the  missile's  velocity  vector  with  respect  to 
the  horizontal  reference  .  This  assumes  that  there  are  no 
vertical  crosswinds. 

The  vertical  reference  direction  normal  to  the  earths 
surface  is  referred  to  as  the  "Y"  direction,  "X"  is  the 
horizontal  coordinate  of  the  earth  reference  system  and  is 
the  direction  of  missile  flight.  "Z"  is  the  transverse 
coordinate.  Propulsion  of  the  missile  along  the  "X" 
direction  is  assumed  to  be  provided  by  a  separate  thrust 
control  system  such  that  the  horizontal  component  of  missile 
velocity  remains  constant. 

The  missile  plant  must  be  merged  with  the  motor  driven 
fin  positioning  controller.  High  speed  DC  motors  using 
rare  earth  permanent  magnets  for  field  excitation  permit 
relatively  high  voltage  inputs  on  the  order  of  150-200  VDC 
to  operate  at  maximum  speed.  A  limitation  of  160  volts  has 
been  established  in  this  simulation  and  allows  approximately 
+  or  -  26  degrees  of  fin  deflection  for  missile  control. 
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Figure  4.1  Missile  Pitch  Plane  Dynamics 
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V.   ALTITUDE  HOLD  CONTROLLER 

The  purpose  of  the  design  of  an  altitude  controller  in 
this  simulation  is  to  provide  a  means  of  accessing  the  real 
ability  of  a  typical  state  of  the  art  brushless  DC  motor  to 
adequately  control  a  typical  tactical  cruise  missile  in 
steady  state  flight.  Parameters  may  be  varied  to  model 
specific  missile  parameters  including  missile  length, 
weight,  effective  surface  area,  distance  from  center  of 
gravity  to  the  center  of  pressure  of  the  missile  and  to  the 
center  of  rotation  of  the  fin  axis,  and  the  control  surface 
size.  Control  system  parameters  can  be  adjusted  to  within 
reasonable  limits  to  allow  system  bandwidth  to  be  above  100 
radians  per  second  if  desired.  The  amount  of  position 
overshoot  can  also  be  minimized  however  a  tradeoff  in  time 
required  to  reach  the  desired  steady  state  altitude  will 
occur. 

It  is  desired  in  this  simulation  to  design  the 
controller  so  that  for  the  typical  cruise  missile 
specifications  chosen,  that  steady  state  oscillations  in 
height  are  within  +  or  -  one  foot  from  a  desired  height 
signal  and  that  this  condition  is  reached  in  no  more  than 
four  missile  time  constants.  The  specific  missile  being 
simulated  has  a  time  constant  approximately  equal  to  one 
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second,  therefore  a  steady  state  condition  should  exist 
within  four  seconds  from  initial  missile  release.  Although 
it  is  not  specifically  the  goal  of  the  controller  designed 
in  this  simulation  to  respond  quickly  to  step  changes  in 
height,  this  would  be  a  desirable  characteristic  of 
operation  and  would  increase  the  value  of  the  model. 

Further  assumptions  include  the  existence  of  a  gyro  on 
board  the  missile  to  provide  the  missile  pitch  angle  (y) ,  an 
altimiter  to  provide  missile  height  above  the  earth 
reference   plane,   and   a   clock   timer   and   associated 

electronics  to  determine  the  vertical  acceleration  of  the 

2     2 

missile  (d  Y/dt  ).    It  has  been  assumed  that  no  relative 

wind  exists  for  simplicity.  Using  the  approximation  that 
the  angle  of  the  velocity  vector  above  the  horizontal 
reference  plane  (B)  is 

6=  tan_1[dY/dt)  /  (dX/dt)] 

it  is  evident  that  the  missile  attack  angle  (  a  )  can  be 
obtained  as: 

a  =  Y  -  £ 

Thus  the  necessary  information  is  provided  to  make  use  of 
the  previously  derived  missile  equations  of  motion  to  begin 
the  altitude  controller. 
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A.   UNCOMPENSATED  MISSILE  PLANT 

The  missile  dynamics  are  combined  with  the  fin 
controller  in  Fig.  5.1.  This  system  to  be  controlled  has 
three  inputs.  The  primary  input  signal  provides  voltage 
through  a  power  amplifier  to  drive  the  fin  controller  which 
then  positions  the  control  fins  to  provide  the  fin  angle  [6) 
input  to  the  missile  model.  The  Secondary  input  ,  but  of 
great  significance  is  the  input  that  comes  from  the 
acceleration  caused  by  the  gravity  acting  on  the  mass  of  the 
missile  itself.  Finally  a  fin  bias  voltage  (Vb)  must  be 
applied  to  help  counteract  the  initial  application  of  the 
missile  weight  to  the  system  dynamic  equations.  The  effect 
of  the  fin  bias  is  to  increase  the  initial  system 
stabilization  time  dramatically.  Without  it  the  missile 
will  fall  a  great  deal  before  the  system  can  catch  up  to 
this  initial  weight  input. 

To  assist  in  controller  design,  in  addition  to 
calculation  of  the  equivalent  transfer  function  of  the  fin 
controller,  Program  1  (appendix  C)  also  calculates  missile 
system  parameters  K1  through  K5 ,  and  the  overall 
uncompensated  missile  plant  transfer  function.  All  missile 
and  fin  parameters  can  be  changed  within  this  program. 
Sample  output  is  provided  in  appendix  B  for  the  parameters 
used  in  this  simulation. 

It  is  seen  from  appendix  B  that  the  uncompensated 
missile  plant  yields  a  7  th  order  type  one  system  with  one 
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zero.  Several  sets  of  missile  parameters  were  evaluated. 
In  general  a  mechanical  resonance  occurs  in  the  open  loop 
Bode  plot  at  approximately  one  radian  per  second  input 
frequency,  see  Fig.  5.2. 

B.   COMPENSATION  OF  MISSILE  PLANT 

The  mechanical  resonance  is  evidenced  by  the  presence  of 
two  complex  roots  in  the  uncompensated  missile  transfer 
function  near  the  resonance  peak  as  seen  on  the  Bode  plot  of 
the  uncompensated  plant. 

The  most  common  first  approach  to  compensating  for  a 
mechanical  resonance  is  to  decrease  the  system  gain  such 
that  the  resonance  peak  falls  well  below  (at  least  6  dB)  the 

0  gain  crossover  point.  The  problem  that  occurs,  however  is 
that  a  minimum  bandwidth  of  6.28  radians  per  second  should 
be  achieved  to  insure  adequate  response  for  systems  down  to 

1  second  time  constants.  Adding  some  conservatism  to  this 
bandwidth  requirement  calls  for  a  system  bandwidth 
requirement  of  approximately  10  radians  per  second. 

The  above  observations  and  previously  established  design 
requirements  lead  to  the  idea  of  the  possible  employment  of 
a  PID  controller  to  compensate  for  the  dominant  complex 
roots  of  the  uncompensated  plant.  In  theory  once  this  is 
accomplished  it  should  be  a  relatively  simple  matter  to  use 
Lead-Lag  compensation  to  adjust  the  open  loop  Bode  response 
of  the  system  transfer  function  for  proper  phase  margin  and 
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bandwidth  for  a  well  damped  quick  responding  plant.  Recall 
that  the  uncompensated  system  is  type  one,  and  that  a  PID 
controller  also  adds  a  pole  at  0  to  the  overall  system. 
This  should  allow  zero  steady  state  error  to  ramp  inputs, 
but  also  necessitates  the  use  of  two  Lead  compensator 
sections  to  provide  the  necesary  system  phase  margin 
required . 

The  compensated  system  block  diagram  is  shown  in  Fig. 
5.3.  Unless  changes  to  motor  or  missile  parameters  are 
relatively  small,  the  system  will  need  to  be  recompensated . 
The  first  step  to  recompensate  is  enter  the  new  parameters 
in  the  Basic  program  to  determine  the  uncompensated  missile 
transfer  function  then  use  this  as  the  basis  for  the  Bode 
plot.  Next,  because  the  zero  of  this  transfer  function  is 
always  nearly  cancelled  by  one  of  the  real  roots  of  the 
function,  the  main  consideration  is  the  set  of  dominant 
complex  roots.  These  roots  can  be  multiplied  to  give  the 
equivalent  second  order  polynomial  in  coefficient  form.  The 
PID  controller  contributes  the  following  transfer  function 
to  the  forward  transfer  function  of  the  missile  plant: 


VpiD  =  [(KKD)S2  +  (KKp)S  +  (KKj)]  /  S 


The  complex  roots  of  the  system  can  therefore  be  cancelled 
by  coosing  the  PID  constants  equal  to  the  coefficients  of 
the  above  derived  second  order  system  polynomial.   The  next 
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step  is  to  include  this  transfer  function  along  with  two 
lead  sections  in  the  forward  system  transfer  function  for 
the  Bode  analysis. 

One  method  that  works  well  for  choosing  the  proper  lead 
compensator  sections  to  give  a  system  bandwidth  above  10 
radians  per  second  is  to  place  a  zero  at  .1  and  a  zero  at 
300  then  use  the  second  Lead  section  to  fine  tune  the  open 
loop  Bode  plot  to  give  a  phase  margin  of  45  to  55  degrees. 
For  the  parameters  of  the  system  as  indicated  previously 
placing  the  second  zero  at  .8  and  the  pole  at  15  satisfies 
the  originally  specified  design  requirements,  see  Fig.  5.6 
for  the  output  response  to  a  zero  reference  signal  input. 
Also  see  Fig.  5.7  and  Fig  5.8  for  response  to  step  inputs  to 
provide  a  missile  climb  of  100  feet  and  a  missile  drop  in 
altitude  of  10  feet  respectively. 


Figure  5.1  Uncompensated  Missile  Plant 
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Figure    5.2    Open    Loop    Uncompensated    Missile    Plant 
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Figure  5.3  Compensated  Missile  Plant 
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Figure  5.4  Open  Loop  Compensated  Missile  Plant 
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Figure  5.5  Closed  Loop  Compensated  Missile  Plant 
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Figure  5.6  Zero  Reference  Time  Response 
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Figure  5.7  Step  Response  to  +100 
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Figure  5.8  Step  Response  to  -10 
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VI .   CONCLUSIONS  AND  RECOMENDAT I ONS 

A.   CONCLUSIONS 

The  CSMP  model  results  for  simulations  as  described  in 
section  V.  were  confirmed  to  be  within  .001%  of  the  FORTRAN 
language  model  for  the  cruise  missile  altitude  hold 
controller  under  the  same  test  conditions. 

The  missile  system  altitude  hold  controller  meets  and 
exceeds  original  design  requirements  established  for  the 
study  of  the  effects  of  real  load  requirements  on  a  DC  motor 
having  similiar  parameters  to  state  of  the  art  brushless  DC 
motors.  Steady  state  oscillations  in  height  were  less  than 
.1  ft.  as  compared  to  the  design  specification  of  less  than 
or  equal  to  one  foot.  Settling  time  was  less  than  4  sec. 
for  all  simulations.  This  meets  or  exceeds  the  design 
specification  on  settling  time  of  less  than  or  equal  to  4 
time  constants  (time  constant  of  the  simulated  missile  is 
approximately  1  sec).  The  system  gain  had  to  be  lowered  by 
a  factor  of  10  to  allow  the  compensator  output  to  better 
interact  with  the  vertical  velocity  feedback  of  the  system. 
This  factor  along  with  saturation  of  the  fin  position 
controller  during  transient  operation  caused  some  steady 
state  error  to  input  reference  signals.   This  effect  can  be 
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counteracted  by  choosing  reference  signals  appropriate  to 
establish  the  desired  output  height. 

The  closed  loop  bandwidth  of  the  fin  controller  is  large 
for  a  servo  mechanism.  This  is  theoretically  possible  since 
large  input  voltages  are  used  and  because  the  load  inertia 
felt  on  the  motor  is  inversly  proportional  to  the  gear 
reduction  ratio.  The  large  bandwidth  should  be  further 
investigated  for  actual  values  of  load  inertia  from  the  fin 
mechanism. 

B.   RECOMMENDATIONS 

For  future  work  it  is  highly  recommended  to  establish 
within  the  simulation  program  a  means  for  adapting  the 
controller  to  the  desired  changes  in  system  parameters. 
Other  means  of  control  may  be  investigated,  in  particular 
incorporating  feedback  compensation  other  than  proportional. 
In  addition  the  steady  state  error  problem  requires  further 
study  to  specifically  identify  and  correct  its  sources. 
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APPENDIX  A: 
LIST  OF  SYMBOLS 

Symbol  name     Description /Units 

2 

Af  area  of  fin  surface  (ft  1 

Am  missile  lift  surface  (ft  ) 

Arm(L2)  fin  moment  arm  (ft) 

Atkang(a)  missile  attack  angle  (radians) 

Beta(8)  angle  of  Vm  wrt  horizontal  (radians) 

Bl  viscous  load  friction  (oz- in/rad/s) 

Bm  viscous  motor  friction  (oz- in/rad/s) 

Bt  total  viscous  friction  (oz- in/rad/s) 

Cd  coefficient  of  drag 

Cg  missile  center  of  mass 

Clf  fin  coefficient  of  lift 

Cll  fin  load  torque  generator  lift  coefficient 

Clm  missile  coefficient  of  lift 

Cmq  moment  constant  of  aerodynamic  body 

Cp  missile  center  of  pressure 

Cr  center  of  fin  rotation 

DDOT  second  derivative  wrt  time  of  a  variable 

DOT  first  derivative  wrt  time  of  a  variable 

Eint  motor  integral  control  output 

Epi  motor  integ-prop  control  output 

Eprop  motor  prop  control  output 

Epsh  missile  position  error 

Errl  fin  position  error 

Finang(6)  fin  position  (rad) 

Findeg  fin  position  (degrees) 

Finsiz(Af)  lift  area  of  fins  (ft  ) 

Gamma(Y)  missile  axis  angle  wrt  ref  direction  (rad) 

Grav  Gravity  constant  32  (ft/s  ) 

Hk  missile  position  feedback  constant 

Href  missile  commanded  height  (ft) 

Im  motor  current  (amps) 

Jl  fin  system  inertia  (oz/in/s  ) 

Jlp  fin  system  inertia  through  gear  reduction 

Jm  motor  inertia  (oz/in/s  ) 

Jt  total  motor  system  inertia  (oz/in/s  ) 

Kl  missile  constant 

K2  missile  constant 

K3  missile  constant 

K4  missile  constant 

K5  missile  constant 

Kb  back  emf  constant  ( vol ts/rad/s) 

Kbac  tack  feedback  plus  motor  back  emf 
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Kh 
Ki 

KKd 

KKi 

KKp 

Knvrt 

Kp 

Kpwr 

Kt 

Ktac 

LI 

L2 

LL1 

LL2 

Lm 

Mass 

Missiz (Am) 

N 

Nalph 

Ndelt 

PI 

P2 

Phi (0) 

Pwr 

Qk 

Ra 

Roe  (P) 

Srg 

Terr 

Theta 

Tl 

Tm 

Tmissu 

Vaf  in 

Vb 

Vbias 

Vdir 

Velfed 

Vinpwr 

Vint 

Vprop 

Wm 

Wn 

Wt 

X 

Y 

Z 

Zl 

Z2 


missile  position  feedback  constant 

motor  compensator  integral  constant 

missile  compensator  derivative  constant 

missile  compensator  integral  constant 

missile  compensator  proportional  constant 

motor  position  feedback  constant 

motor  compensator  proportional  constant 

power  amplifier  gain 

motor  torque  constant  (oz-in/amp) 

tachometer  feedback  constant 

distance  from  Cg  to  Cp  (ft) 

distance  from  Cg  to  Cr  (ft) 

missile  lead  filter  1 

missile  lead  filter  2 

missile  length  (ft) 

mass  of  missile 

lift  area  of  missile  (ft  ) 

gear  reduction  ratio 

fin  aerodynamic  parameter 

missile  aerodynamic  parameter 

missile  compensator  pole 

missile  compensator  pole 

missile  ref  direction  angle  to  earth  surface 

motor  power  (watts) 

aerodynamic  quality  constant 

motor  armature  resistance  (ohms) 

air  density  (slugs/ft  ) 

rate  feedback  constant  of  missile 

motor-load  torque  error 

motor  shaft  position  (rad) 

fin  load  torque  (oz-in) 

motor  torque  (oz-in) 

uncompensated  missile  transfer  function 

voltage  applied  to  vin  (volts) 

fin  bias  voltage  (volts) 

fin  bias  voltage  (volts) 

missile  compensator  derivative  sect,  output 

missile  velocity  feedback  signal 

input  signal  to  power  amp 

missile  compensator  integral  sect,  output 

missile  compensator  integral  sect,  output 

motor  speed  (rad/s) 

normal  force  due  to  missile  weight 

missile  weight  (pounds) 

missile  ref.  flight  direction,  horizontal 

vertical  coordinate  axis 

transverse  coordinate  axis 

missile  compensator  zero 

missile  compensator  zero 
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APPENDIX  B: 

PROGRAM  1  OUTPUT 

************************************************************ 

UNCOMPENSATED  MOTOR  TRANSFER  FUNCTION: 

15.9 
G1(S)  =  

SS(. 03014)  +  S(176.8125)  +  (125.5584) 

************************************************************ 
COMPENSATED  MOTOR  FORWARD  TRANSFER  FUNCTION  G  (S ) =GC  (S ) Gl  (S )  : 

S(3180)  +  (1590) 
G(S)  =  

SSS(. 03014)  +  SS(176.8125)  +  (125.5584) 

************************************************************ 
COMPENSATED  FIN  CONTROL  SYSTEM  GEQ (S ) =G (S ) / (1+G (S ) H (S ) ) : 

S(3180)  +  (1590) 
GEQ  (S)= 

SSS(. 03014)  +  SS(176.8125)  +  S(1113126)  +  (556500) 

************************************************************ 
MISSILE  EQUATION  OF  MOTION  COEFFICIENTS: 

YDDOT  =  (182.6304)  *  ATKANG  -  (18.26304)  *  GAMMA  -  WN 

GDDOT  =  (18.26)  *  FINANG  -  (219156)  *  ATKANG  -  (2.739)*  GDOT 

************************************************************ 
UNCOMPENSATED  MISSILE  TRANSFER  FUNCTION: 

S(9545876)  +  (4772938) 
TMISSU  =  

S~7(.03)+S~6 (176. 9) +S~5(1113611)+S~4  (4166233)  + 

S*3 (2. 59E+07)+S*2(1.697E+07)+S (2386469) 

************************************************************ 

SRG  =  2   KPWR  =1   WT  =  1000   VM  =  2000 
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APPENDIX  C: 
PROGRAM  1  LISTING 


REM 

THIS  PROGRAM  IS  WRITTEN  IN  BASIC  LANGUAGE 

AND  WILL 

REM 

RUN  ON  MOST  PERSONAL  COMPUTERS 

REM 

THE  PURPOSE  OF  THIS  PROGRAM  IS  TO  DETERMINE  TRANSFER 

REM 

FUNCTION  COEFFICIENTS  FOR  MOTOR  AND  UNCOMPENSATED 

REM 

MISSILE  USING  VARIABLE  SYSTEM  PARAMETERS 

REM 

REM 

NOTE:  MOST  BASIC  INTERPRETERS  REQUIRE  LINE 

NUMBERS 

REM 

TO  PRECEED  THE  PROGRAM  STATEMENTS.  INCLUDE 

THESE 

REM 

IN  THE  ACTUAL  PROGRAM. 

REM 

KP  = 

;  200 

KI  = 

■    100 

KT  = 

■■    15.9 

KNVRT  =  35 

N  = 

10 

BM  = 

■■    .00015 

BL  = 

'  .0015 

BT  = 

:  BM  +  (B./(N~2) ) 

RA  = 

■    2.74 

KTAC 

:  =  1 

KB  = 

•■    .112 

KBAC 

:  =  KTAC  +  KB 

JM  = 

■     .001 

JL  = 

■■     .01 

JT  = 

'  JM  +  (JL/(N~2) ) 

CL  = 

;   .1 

ARM 

=  .132 

ROE 

=  .002378 

AF  = 

•    2 

VM  = 

■■    2000 

REM 

REM 

THIS  PORTION  DETERMINES  THE  UNCOMPENSATED 

MOTOR 

REM 

TRANSFER  FUNCTION 

REM 

PRINT  "***************************************************" 

KTL 

=  (CL*ARM*ROE*AF*VM*VM)/2 

D2  = 

:  JT*RA*N 

Dl  = 

'  (RA*BT*N)+  (KT*KBAC*N) 

D0  = 

=  KTL 

PRINT  "UNCOMPENSATED  MOTOR  TRANSFER  FUNCTION:" 

PRINT 

PRINT  "            ";KT 

PRINT  "G1(S)  =  

it 
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PRINT  "  SS(";D2;")  +  S(";D1;")  +  (";D0;")" 

PRINT 

PRINT  "***************************************************" 

REM 

REM  THIS  PORTION  OF  THE  PROGRAM  DETERMINES  THE  COEFFICIENTS 

REM  OF  THE  FORWARD  TRANSFER  FUNCTION  OF  THE  MOTOR 

REM  WHERE   G(S)  =  GC  ( S )  *  G1(S) 

REM 

Nl  =  KP  *  KT 

N0  =  KI  *  KT 

PRINT  "COMPENSATED  MOTOR  FORWARD  TRANSFER  FUNCTION" 

PRINT  "G(S)  =  GC(S)G1(S)  :" 

PRINT 

PRINT  "  S(";N1;")  +  (";N0;")" 

PRINT  "G(S)  =  " 

PRINT  "         SSS(";D2;")  +  SS(;Dl;")  +  S(";D0;")" 

PRINT 

PRINT  "***************************************************" 

REM 

REM  THIS  PORTION  DETERMINES  THE  EQUIVALENT  TRANSFER 

REM  FUNCTION  OF  THE  COMPENSATED  MOTOR  SYSTEM  INCLUDING 

REM  THE  FEEDBACK  LOOP. 

REM 

El  =  Nl 

E0  =  N0 

F3  =  D2 

F2  =  Dl 

Fl  =  D0  +  (N1*KNVRT*N) 

F0  =  N0  *  KNVRT  *  N 

PRINT  "COMPENSATED  FIN  CONTROL  SYSTEM" 

PRINT  "GEQ(S)  =  G(S)/(1+G  (S)H  (S) )  :" 

PRINT 

PRINT  "  S(";E1;")  +  (";E0;")" 

PRINT  "GEQ(S)  =  " 

PRINT  "  SSS (";F3;")+SS(";F2;")+S  (";F1; ")  +  (";F0; ") " 

PRINT 

PRINT  '*  ****************************************************" 

REM 

REM  THIS  PORTION  DETERMINES  THE  COEFFICIENTS  FOR  THE 

REM  UNCOMPENSATED  MISSILE  EQUATIONS  OF  MOTION. 

REM 

QK  =  (ROE*VM*VM)/2 

AM  =  12 

CD  =  .01 

L2  =  5 

LI  =  1 

LM  =  10 

CMQ  =  .5 

GRAV  =  32 

WT  =  1000 

MASS  =  WT  /  GRAV 
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IZ  =  (1/12)  *  MASS  *  LM  *  LM 

NDELT  =  CL  *  AF  *  QK 

NALPH  =  CL  *  AM  *  QK 

Kl  =  NALPH  /  MASS 

K2  =  (CD  *  AM  *  QK)  /  MASS 

K3  =  (NDELT  *  L2)  /  IZ 

K4  =  (NALPH  *  LI)  /  IZ 

K5  =  ( (CMQ  *  AM  *  LM  *  LM  *  QK)  /  (2  *  VM) )  /  IZ 

PRINT  "MISSILE  EQUATION  OF  MOTION  COEFFICIENTS  : " 

PRINT 

PRINT  "YDDOT  =  (";K1;")  *  ATKANG  -  (";K2;")  *  GAMMA  -  WN" 

PRINT 

PRINT  "GDDOT=  (";K3; " ) *FINANG- (";K4; ") *ATKANG- (";K5; ") *GDOT" 

PRINT 

PRINT  "****************************************************'• 

REM 

REM  THIS  SECTION  INCORPORATES  THE  FIN  CONTROLLER  AND 

REM  MISSILE  EQUATIONS  OF  MOTION  ALONG  WITH  A  VERTICAL 

REM  VELOCITY  FEEDBACK  LOOP  AND  POWER  AMP  TO  FORM  THE 

REM  BASIC  MISSILE  SYSTEM  THAT  IS  TO  BE  CONTROLLED.  THUS 

REM  WE  HAVE  TMISSU,   (THE  UNCOMPENSATED  MISSILE  TRANSFER 

REM  FUNCTION) . 

REM 

SRG  =  10 

KPWR  =  1 

Ml  =  KPWR  *  K3  *  (Kl  -  K2) 

NN1  =  El  *  Ml 

NN0  =  E0  *  Ml 

DD7  =  F3 

DD6  =  (F2)  +  (F3  *  K5) 

DD5  =  (Fl)  +  (F2  *  K5)  +  (F3  *  K4 ) 

DD4  =  (F0  *  SRG)  +  (Fl  *  K5)  +  (F2  *  K4 ) 

DD3  =  (F0  *  K5)  +  (Fl  *  K4 ) 

DD2  =  (F0  *  K4)  +  (El  *  (Ml/SRG) ) 

DD1  =  E0  *  (Ml/SRG) 

PRINT  "UNCOMPENSATED  MISSILE  TRANSFER  FUNCTION:" 

PRINT 

PRINT  "  S(";NN1;")  +  (";NN0;")" 

PRINT  "TMISSU  =  " 

PRINT  "  S~7  (";DD7; ")+S~6  (";DD6; ") +S~5  (";DD5; ")+  " 

PRINT 

PRINT  "     " 

PRINT  "     S~4  (";DD4; ") +S "3  (  " ; DD3 ; ") +S~2 ( ; DD2 ; " ) +S  (  " ; DDl; " ) " 

PRINT 

PRINT  "****************************************************•• 

PRINT  "SRG  =  ";SRG;"  KPWR  =  ";KPWR;"  WT  =  " ; WT ; "  VM  =  ";VM;" 

PRINT  "LENGTH  =  " ; LM 

END 
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APPENDIX  D 


PROGRAM  2  LISTING 


//FRANKLIN  JOB  (2832,0116), 
//*MAIN  ORG=NPGVMl.2832P 
//  EXEC  CSMPXV 
//X. COMPRINT  DD  DUMMY 
//X.SYSPRINT  DD  DUMMY 
//X.SYSIN  DD  * 


FRANKLIN ' ,CLASS=C 


INITIAL 

CONSTANT 

CONSTANT 

CONSTANT 

CONSTANT 

PARAMETER 

PARAMETER 

PARAMETER 

PARAMETER 

PARAMETER 

PARAMETER 


BM 
JL 
JM 
LA 


00015, 
01,  PI 
001 


BL  =  0.0015, 
=  3.14159265 


,  KB 
0016,  RA 
THFSAT  =  13.0, 
MISSIZ  =  12.0, 
WT  =  1000.  ,L1  =  1.0, 
CLF  =  .1,  CLM  =  .1 
GRAV  =  32. ,CD  =  .01, 
Zl  =  0.1,  PI  =  200.  , 


KT  =  15.9 


=  0.112 
=  2.740,  N  = 
ARM  =  0.132, 
FINSIZ  =  2.0 
L2  =  5 


CMQ  = 
Z2  =  5 


10.0 

ROE  =  0.002378 
AIRSPD  =  2000 
0,  LM  =  10 . 

5,  LAMBDA  =  0. 
,  P2  =  50. 


KT  —  TORQUE  CONSTANT  (OZ-IN/AMP) 

KB  —  BACK  EMF  CONSTANT  (VOLT/RAD/S) 

RA  —  RESISTANCE  OF  THE  MOTOR  (OHM) 

BM  —  VISCOUS  FRICTION  COEFFICIENT  OF  THE  MOTOR 

(OZ-IN/RAD/S) 
BL  —  VISCOUS  FRICTION  COEFFICIENT  OF  THE  LOAD 
BLP  —  VISCOUS  FRICTION  COEFFICIENT  OF  LOAD  THROUGH 

REDUCTION  GEARS 
BT  —  TOTAL  VISCOUS  FRICTION  OF  THE  MOTOR  SYSTEM 
JM  —  INERTIA  OF  THE  MOTOR  (OZ-IN/S-S) 
JL  —  INERTIA  OF  THE  LOAD 

JLP  —  INERTIA  OF  THE  LOAD  THRU  REDUCTION  GEARS 
JT  —  TOTAL  INERTIA  OF  THE  MOTOR  SYSTEM 
Al  =  LA/RA   —   THE  ELECTRICAL  TIME  CONSTANT  OF  THE 

MOTOR 
A2  ■  JT/BT     —   THE  MECHANICAL  TIME  CONSTANT  OF  THE 

MOTOR 


NOSORT 


BLP  =  BL/(N**2) 
JLP  =  JL/(N**2) 
JT  =  JM  +  JLP 
BT  =  BM  +  BLP 
Al  =  LA  /  RA 
A2  =  JT  /  BT 
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MASS 

=  WT  /  GRAV 

IZ  = 

(1./12)  *  MASS 

XDDOT 

=  0.0 

GDDOT 

=  0.0 

*  CONTROL  PARAMETERS 

VXINIT  =  AIRSPD 

VM  =  , 

AIRSPD 

KI  = 

100.0 

KP  = 

200.0 

KTAC 

=  1.0 

KNVRT 

=  35.0 

KKI  = 

21.0 

KKP  = 

3.0 

KKD  = 

1.0 

INVZ1 

=  1.0/Z1 

INVP1 

=  1.0/P1 

INVZ2 

=  1.0/Z2 

INVP2 

=  1.0/P2 

KPWR 

=  1. 

VBIAS 

=  82. 

SRG  = 

2. 

HK  = 

1.0 

DYNAMIC 

*  INPUT  SECTION 

HREF  =  -10. 

*  BEGIN  MISSLE  CONTROL  SECTION 

EPSH  =  HREF  -  (HK  *  Y) 

LL1  =  LEDLAG (0.0001, INVZ 1 , INVPl , EPSH ) 

LL2  =  LEDLAG (0. 0001, INVZ2, INVP2,LL1) 

VPROP  =  LL2  *  KKP 

VINT  =  KKI  *  INTGRL (0.0, LL2) 

VDIR  =  KKD  *  DERIV  (0.0, LL2) 

VPID  =  VPROP  +  VINT  +  VDIR 

VELFED  =  (SRG  *  YDOT) 

VINPWR  =  (VPID/10.)  -  VELFED 

VPWR  =  VINPWR  *  KPWR 

VA  =  VPWR  +  VBIAS 

VAFIN  =  LIMIT (-160. ,160. ,VA) 

*  BEGIN  FIN  CONTROL  SECTION 

ERRl  =  VAFIN  -  (KNVRT  *  THETA) 

*  PROPORTIONAL  INTEGRAL  CONTROL 

EPROP  =  ERRl  *  KP 

EINT  =  KI  *  INTGRL (0.0 , ERRl) 

EPI  =  EPROP  +  EINT 

*  TACHOMETER  FEEDBACK  PLUS  BACK  EMF 

KBAC  =  (KTAC  +  KB) 
VBACK  =  KBAC  *  WM 
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ERR2  =  EPI  -  VBACK 

*  MOTOR  MODEL 

IM  =  ERR2  *  (1.0/RA) 

TM  =  IM  *  KT 

TERR  =  TM  +  TL 

WM  =  REALPL (0.0,A2,TERR/BT) 

WMRPM  =  WM  *  (30. /PI) 

THETA  =  INTGRL  (0.0, WM) 

*  MOTOR  SHAFT  POSITION 

THDEG  =  THETA  *  (180. /PI) 
WMF IN  =  WM  /  N 

*  FIN  POSITION  (POSITIVE  IS  UPWARD  MOVEMENT  OF  AFT 

*  PORTION  OF  FIN) 

FINANG  =  THETA  /  N 

FINDEG  =  FINANG  *  (180. /PI) 

PWR  =  WM  *  TM  *  .0070615 

*  FIN  LOAD  TORQUE  RESULTING  FROM  DYNAMIC  FIN  DEFLECTION 

CLL  =  -(0.1  *  LIMIT (-THFSAT, THFSAT , FI NDEG ) ) 

TL  =  ARM  *  ((ROE)/2)  *  FINSIZ  *  ( AI RSPD**2 ) *CLL 

*  MISSILE  MODEL 

*  FIN  POSITION  IS  INPUT  TO  THE  MISSILE  MODEL  HERE  AS 

*  FINANG  IN  RADIANS 

*  AIRSPD  USED  HERE  FOR  SIMPLIFICATION  AND  (I.C.) 

*  RATHER  THAN  VM 

QK  =  (ROE  *  AIRSPD  *  AIRSPD)  /  2. 

NDELT  =  CLF  *  FINSIZ  *  QK 

NALPH  =  CLM  *  MISSIZ  *  QK 

Kl  =  NALPH 

K2  =  CD  *  MISSIZ  *  QK 

*  REFERENCE  DIRECTION  IS  HORIZONTAL  THEREFORE 

*  COS (LAMBDA) =1. 

WTN  =  MASS  *  GRAV  *  1. 

K3  =  NDELT  *  L2 

K4  =  NALPH  *  LI 

K5  =  (CMQ  *  MISSIZ  *  LM  *  LM  *  QK)  /  (2.  *  VM) 

GDDOT  =  (K3  *  FINANG  -  K4  *  ATKANG  -  K5  *  GDOT)/IZ 

GDOT  =  INTGRL (0.0, GDDOT) 

G  =  INTGRL (0.0, GDOT) 

GDEG  =  G  *  (180. /PI) 

YDDOT  =  (  Kl  *  ATKANG  -  K2  *  G  -  WTN)/  MASS 

YDOT  =  INTGRL (0.0, YDDOT) 

Y  =  INTGRL (0.0, YDOT) 

XDDOT  =  0.0 

XDOT  =  INTGRL (VXINIT, XDDOT) 

X  =  INTGRL (0.0, XDOT) 

VM  =  (XDOT  **2  +  YDOT  **2)**0.5 

BETA  =  ATAN2  (YDOT, XDOT) 

BETDEG  =  BETA  *  (180. /PI) 
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ATKANG  =  G  -  BETA 

ATKDEG  =  ATKANG  *  (180. /PI) 

TERMINAL 

TITLE  MISSILE  ALTITUDE  HOLD  CONTROLLER 

METHOD  RKSFX 

TIMER  FINTIM  =  10 . 0 , OUTDEL= . 1 , PRDEL= . 1 , DELT= . 0001 

OUTPUT  Y, BETDEG,GDEG, ATKDEG, F I NDEG 

PRINT  ATKDEG, FINDEG,Y 

LABEL  MISSILE  PARAMETERS 

PAGE  MERGE 
END 
STOP 
ENDJOB 
/* 
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